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ABSTRACT 


To gather more information about the solar system, future missions 
to Mars should include visits to many remote locations on the planet surface 
for scientific experimentation. An autonomous roving science vehicle that 
relies on terrain data acquired by a hierarchy of sensors for navigation is 
one method of carrying out such a mission. Included in the hierarchy of 
sensors is a short range sensor with sufficient resolution to detect every 
possible obstacle and with the ability to make fast and reliable terrain 
characterizations. A multi-laser, multi-detector triangulation system is 
proposed as a short range sensor. The general system is studied to deter- 
mine its perception capabilities and limitations. A specific rover and low 
resolution sensor system is then considered. After studying the data obtained, 
a hazard detection algorithm is developed that accounts for all possible 
terrains given the sensor resolution. Computer simulation of the rover on 
various terrains is then used to test the entire hazard detection system. 
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I. INTRODUCTION 

The use of remote sensors to explore the solar system has coa* 
trlbuted much knowledge In the search for answers to numerous questions 
concerning » particularly^ the origin of the universe and the existence of 
extraterrestrial life* Considerable effort has been focused on explora- 
tion of the planet Mars and successes achieved to date represent a great 
achievement. As with any good scientific investigation » however, more new 
questions have been raised than resolved. To answer these new questions, 
an extensive surface exploration of Mars should be undertaken. Regardless 
of the type of experiments to be performed, a thorough investigation of 
the planet surface should involve visiting many sites on a trajectory of 
several hundred kilometers. 

One method of conducting widely separated experiments is to con- 
struct many sets of scientific equipment and to land one set at each site. 

While this plan is feasible, it requires much duplication of effort and 
hardware. Another alternative is a mobile science station that can visit 
every site. The time required to visit every site is now an important con- 
sideration. A vehicle that cannot deal with a wide variety of adverse terrains 
id.ll have few traversable trajectories available. A higher mobility vehicle, 
on the other hand, can take advantage of more direct yet possible adverse 
terrains thereby minimizing travel time and maximizing science time. One 
suggested vehicle is a "tumbleweed” that is blov’n across the planet surface 
by wind. It is not likely, though, that the tumbleweed will reach all 
of the desired sites by chance. Furthermore, even such a high mobility 
vehicle can get permanently lodged in one location. For these reasons, the 
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vehicle to be used should be controllable. 

Selection of a desired path for a roving vehicle should proceed 
on several levels. Obtaining an overall view the . *^ain to be tra- 
versed is a good first step. Without such information » the situation is 
similar to going on vacation without a road map. v^. unnecessarily long 
route will probably be taken. To gather information over several hundred 
kilometers » an orbiting sensor is a good choice. Due to a resolution of 
only 100-200 meters, however, many smaller objects that may be hazardous 
to the rover are not detected. Therefore, shorter range, higher resolu- 
tion sensors are required in addition to the orbiting sensor. Compared 
to the long range sensor, short range sensors will have a higher scanning 
frequency and will require a higher frequency of path selection decision. 
Given long round trip communications delay times of from nine to forty 
minutes and limi^ced ^windows’* during which information can be transmitted, 
direct earth control of the vehicle is not a routine matter. Most of the 
path selection decisions should originate on Mars, A manned mission to 
Mars is a possible solution but .s made difficult by the long duration of 
the mission, higher risk involved, additional payload required, and a neces- 
sary return trip. An autonomous roving vehicle with onboard short range 
sensors can provide a simpler alternative. 

One possible strategy is to first plan a rough path to be tra- 
versed that avoids major terrain features based on orbitcr sensor data, 
Television cameras on board the vehicle enable controllers on earth to 
locate landmarks and to choose intermediate targets along the route, 

Finally, a short range sensor with appropriate software is employed to 
*:eer the vehicle safetly from one target to the next. 
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The focus of this paper is to Investigate the short range sersor 
concept. A general sensor scheme Is proposed and its characteristics are 
analyzed. For a particular given setu^or, a terrain modelling algorit'im 
Is developed and is tested and evaluated by means of computer simulacion. 
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H. BACKGROuiiD 

There are several shorter range sensor systems currently ’'•‘ng 
studied. Techniques such as TV imaging and laser range finding are being 
developed for use over a range of about fifty meters. With these syster:s 
the vehicle s*-ops, a scan is taken, the data are processed, a path is 
selected, and the vehicle moves along the desired trajectory. The only 
problem is that to get sufficient resolution over a fifty meter range, 
a large quantity of data and, therefore, much data processing time are re- 
quired. The result is a vehicle moving only on the order of 400 meters 
per day. With a mission covering a distance several orders of magnitude 
greater, time becomes in important issue, 

A better solution might be to maintain the same resolution 
while shortening the range to a few meters and, thus, decreasing the 
amount of data to be processed. With the Increased scan and decision 
rates made possible by this short range system, vehicle speed can be 
greatlv increased. The only drawback is a very limited field of view 
The midrange sensors with a fifty meter range have a high probability of 
choosing as direct a path as possible, over the fifty meter view. \ short 
range sensor that can see only a few meters at a time will not necessarily 
choose the optimal trajectory. The short range system will prove to be 
superior if the effect of increased speed exceeds the effect of longer 
trajectories so that the overall vehicle displacement over time is increased. 
The increr.se in vehicle speed using a short range system is estimated to 
be at least one order of magnitude by virtue of the enormous data reduction. 
The midrange sensors are not expected to give a comparable reduction in 
path length. Even though a short ronge sensor is not likely to choose the 
optimal trajectory for a trip of several hundred kilometers, a fifty ueter 
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mid range scanner will probably not do much better. 

Use of a short range sensor does not automatically rule out 
techniques such as TV or laser range finding. TV pictures do present a 
time problem, though, due to the extensive ixige enhancement techniques 
that must be applied. Decision rates on the order of one per second are 
necessary for a short range system to be feasible. While laser range 
finding data can be processed quickly enough, the technique is more 
difficult to implement over short ranges because of the increased diffi- 
culty In measuring time of flight. 

An easier technique forobtalning accurate measurements with a 
laser over short ranges is trlangulaticn. The system consists of a laser 
located on a mast with a laser detector located at a known separation, 
Fie»xre 1. When the laser is pulsed, a short segment of the beam inter- 
sects the detector field of view. Knowing the pointing angles and 
locations of both the laser and detector, the location of the line segment 
of intersection can be determined by trigonometry. If a laser pulse 
strikes terrain lying within the detector field of view, scattered light 
is sensed. The terrain is then known to lie somewhere along the line 
segment of intersection. If no return signal is received, the terrain is 
assumed to lie elsewhere. By proper choice of pointing angles and detector 
size, a system can be developed in which a return indicates the presence 
of safe terrain while no return means a hazardous path. Rotating the 
mast enables the scanning of severe 1 azimuths in search of safe paths. 

Figure 2. Such a one laser, one detector system scanning fifteen azimuths 

1 2 

at ten degree spaclngs has been tested at R.P.I, * The vehicle operated 
subject to assumptions that only terrains involving gradients of less than 
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thirteen degrees and step obstacles with less than twelve Inches 
differential were safe. All other terrains resulted In no return 
signal and were assumed hazardous. The surprisingly good perfQrmance 
obtained represents a remarkable achievument since this is the only 
hazard detection system to be successfully field tested. 

While past investigations have demonstrated that the laser/ 
detector triangulation system can work, it is not clear that other 
systems will not perform as well. More sophisticated systems have a 
better chance of choosing more direct trajectories. If the paths chosen 
by the single laser /detector system a,re too erratic, the higher vehicle 
speed may not be enough to offset the effect of longer trajectories. The 
path selection problems are due to uncertainty. Any terrain is character- 
ized by truly safe paths and unsafe paths. Figure 3. The Job of the 
hazard detector is to choose the most direct path from the safe paths 
available. As with any real system, t* re is always some uncertainty 
added. The one laser, one d». rector system bases its decisions on very 
little information and as a result, many terrain classifications are unsure. 
With the success or failure of the mission dependent on avoiding dangerous 
situations, all unsure terrain must be classified as unsafe. The result 
is a smaller number of safe paths available and a reduced ability to select 
a more direct path. A more accurate system is characterized by less un- 
certainty and more available paths. Clearly, if the laser/detector short 
range triangulation hazard detector is to be competitive, the amount of 
uncertainty associated with each scan should be reduced. 

The main source of uncertainty in the single laser/detcctor system 


is the low quality and accuracy of data. Additional laser firings and shorter 
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line segments of intersection would give a better terrain picture, A 
multi-laser, multi-detector system provides the extra data desired. 

Figure 4. Other sources of uncertainty, such as Instrtimentatlon error, 
are neglected because their effect on the lengths and positions of the 
line segments is assumed small. The multi-laser/detector hazard detection 
system is the short range sensor proposed for an autonomous Martian rover. 
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III. THEORY 

Figure 5 Illustrates the generalized multi-laser, multi-detector 
system with a boulder In the field of view, Ihe data obtained are shown 
as the darkened line segments. Note that while it Is obvious from the 
data that a bump occurs In the terrain, the actual contour Is not clear 
and a wide variety of terrain features is possible. Figure 6, In general, 
a single scan does not necessarily produce data that define unambiguously 
a particular obstacle. It is helpftil to leara what the perception capablli^ 
ties of the system are and which parameters can Improve perception. 

Probably the greatest limitation on the perception results from 
the discreteness of system. In order to perceive desired features or 
terrain fluctuations, there is a mlniimim data spacing or rate of sampling 
that must be observed. There is a direct analogy tc sampling of electronic 
signals. In theory, a signal that has a finite bandwidth can be uniquely 
reconstructed after sampling If the sample rate Is at least twice the 
highest frequency contained In the signal. What this means for terrain 
sensing Is that If high frequency or highly fluctuating terrain is Ignored, 
the original terrain can be uniquely reconstructed from sensor data by 
choosing the sampling rate sufficiently high. To some degree the assumption 
that rapidly fluctuating terrain does nr*- exist is a valid one since features 
such as spikes, poles, or tree trunks are not likely to be found on Mars, 

Unfortunately, the theory discussed above assumes that the signal 
is well known at the sample points. This Is not necessarily true for the 
trlangxilatlon sensor. The sample points are really line segments. Even if 
high frequency terrain perturbations are ignored and if the proper sampling 
rate is observed, the original terrain cannot be uniquely reconstructed from 
the data. Figure 7, The most that can be hoped for Is to define an envelope 
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FIGURE 7 


Example of ambiguity resulting from uncertainty at sample points 



16 . 


in which the tecxsln lies. While It Is not trivial in practice^ in theory 
it Is possible to determine the entire range of terrains possible given a 
set of data assuming that high frec^uenclesare Ignored, The size of the 
envelope can be reduced by observing that extreme terrain fluctuations are 
not possible between data points since other adjacent detector would have 
sensed the terrain. Therefore, given the sensor data and some a priori 
knowledge of the character of Martian terrain, an envelope can, 1= theory, 
be constructed in which the terrain is known to lie. While this is not as 
good as completely specifying the terrain location, at least the rosslble 
terrains are boimded and the \incertainty in terrain location is rfeiuced. 

One of the keys to better perception is to reduce the siare of 
the terrain envelope, A logical conclusion may be that more laser pulses 
at intermediate elevation angles will make the envelope better c-ifirssd. 
Doubling the number of laser pulses does improve the situation adiitioaaL 

lasers reveal an Interesting problem. Since adjacent laser sho '5 rrs usually- 
seen by the same detector, the pattern of line segments is very 
Figure 8, As the number of laser pulses approaches Infinity, t~tfi: dius 
actually become a series of contiguous quadrilaterals resembllnr -usTiHelo- 
grams. Figure 9, What is of interest is that the parallelograms. sr» well 
defined. Each parallelogram is joined to its neighbors only at 
vertices. The four sides are formed by the edges of an individTusl. diru.ect.mr 
field of view and two laser pulses. If the locations of all comsrru t^erti-ces- 
are known from the pointing angles of the corresponding lasers xc— ui-uecumrs. 
' en the parallelograms are uniquely defined. The conclusion all 

of the Infonnatlun obtained from an arbitrarily large number of - - suirus 
is totally represented by the location of the n+1 vertices wher'v u 
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nuniber of detectoiT^t S^ce all yeiftlce^ occur at detector bgund{|rlea, 

the laser need only be fired at those points where the terrain intersects 
detector bounda r i e s. Knowing the laser and detector pointing angles, 
the aivelope can be constructed. A -ontlnuous laser that scans for this 
occurrence will do the job. 

The above findings provide an easy method for obtaining an 
accurate terrain envelope. Furthermore, it can be concluded that each 
additional laser contributes a decreasing marginal Increase to the amount 
of information. There is an upper limit to the amount of information and, 
hence, a laser limit to the uncertainty associated with a given mnid>er of 
detectors and an arbitrary nund>er of lasers. The amount of information 
available from a finite detector system can be maximized without increas- 
ing the amount of data that must be processed. 

Just as decreasing the laser spacing gave improved perception, 
similar benefits should be obtained by decreasing individual detector sizes. 
Smaller detector fields of view shorten the line segments of intersection 
and decrease the uncertainty associated with each measurenent, Wherever 
data are taken, the location of the terrain is known more accurately. The 
effect is to decrease the size of the terrain envelope. In the limit as 
the detector fields become Infinitessimally narrow, the line segments of 
interaction are reduced to points. Figure 10, This is the case of ideal 
sampling where the terrain i$ uniquely reconstructed from the data when 
the proper sample rate is observed. 

From the above analysis it is now known that laser density deter- 
mines che sampling rate and, thus, the number of data points while the 
detector ders.. > .:^'.es the data accuracy. It Is possible, although 
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fine an envelope that bounds the set of possible terrains 





given a set of data. It has been shown that an accurate envelope can 
easily be generated by using a continuous laser that scans the terrain for 
detector boundaries. Furthermore, this system represents the optimum 
usage of the laser since the maximum amoimt of Information Is extracted 
with a minlBam of data. The use of very narrow Individual detector 
fields with a sufficient nund>er of laser firings yields data from which 
the actual terra'<n can be uniquely reconstructed. 

While the conclusions drawn look promising, there are practical 
considerations that cannot be overlooked. The main thrust of the analysis 
has been to account for all of the possible terrains that may have given 
rise to a set of data since, for safety's sake, even the Improbable terrains 
cannot be ove> looked. A terrain envelope performs this function and. In 
theory, one can always be generated. Except for a few special cases, 
though, no method has been developed for generating these terrain bounds 
in the general case. Even In the two special cases of narrow laser spac- 
ing and narrow detector fields, the validity of the expected terrain 
envelope breaks doim. In these cases the measurements being made are so 
fine that the assumption that measurement error can be neglected no longer 
holds. The message here is merely a reminder that what can be done in 
theory is not always true in practice. 

There are other considerations to be made when specifying a 
sensor system. The overall detector field of view is of critical importance. 
One reason for a short range sensor is to maintain high resolution with a 
small number of individual detectors. Yet, there Is a lower limit to the 
size of the field. The field of view musr be wide enough to see suffi- 
ciently large sections of obstacles so that meaningful decisions can be 
made. Another constraint is that, particularly under large vehicle pitch 
conditions, rapidly rising or falling terrain may fall outside of the sensor 



field of view. Figure 11, 

Tlie location of the lasece and detectors is also a factor, Vith 
the laser and detector clusters restricted to beiitg on t’le sante mast, 
better results are obtained with a larger separaclou * stween the ^ser 
and detector clusters. Increasing their separation i^xcreases the angles 
between laser beams and detector fields and decreases he lengths of the 
line segments of Intersection, Figiire 12. There are practical limits to 
the degree of separatloa. The laser height cannot exceed the mast height 
while the detectors must be high enough to clear t! e ground. 




FIGURE 12 


Effect of laser-detector mast separation on 
data accuracy 
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IV. ihe elevation scanning laser/mdlti-detector concept 

Having gained some knowledge about general multi-laser, multi- 
detector sensors, attention Is now focused on the specific case of the 
elevation scanner laser system under development at Rensselaer. The geo- 
metry Is Identical to the general case but there are some very Important 
parameter constraints. For slimilatlon purposes, the lasers are placed at 
the top of the mast at a height of 2.0 meters and the detectors are 
located at a height of 1,0 meter, locations which compare well to actual 
vehicle dimensions. The lowest laser and lowest detector are aimed to 
intersect level ground at 1,0 meter. This distance is chosen because 
obstacles closer than 1.0 meter cannot be safely avoided without a backup 
maneuver. The laser firings can be variably spaced but must have an 
average separation of at least one degree. Only twenty detectors vifh 
equal fields of view are available and this represents a major problem, 

A tradeoff must be made between resolution and overall field of view. 

The vehicle encounters terrains varying in slope from -30** to 30* and will 
need a 60* field of view to deal with the most extreme situations. Using 
proper optics the 60* field can be obtained but the individual detector 
fields must be 3* each. The resolution possible from such a system is 
not sufficient to detect certain obstacles. More will be said on this issue 
later. As a compromise, 2* detector fields with a 40* overall field of view 
are chosen for simulation. To maintain a "square" array where laser and 
detector densities are equal, there will also be 20 laser firings of 2* 
Increments, A base design has now been developed with which experiments 
can be undertaken. Figure 13. 

The remaining task Is to develop an algorithm for Interpreting 
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sensor data that, given the uncertainty inherent in the system, accounts 
for all possible terrain features. Unfortunately, none of the earlier 
findings can be applied In this case. The 2" individual detector fields 
result in such large line segments of Intersection that ideal sampling 
and unique reconstruction of the terrain Is not possible. In many cases, 
the lengths of the line segments eqtial or exceed the dimensions of obstacles. 
A terrain envelope can be easily generated using a continuous laser but 
this is not possible given the hardware on the R.P.I. rover. A continuous 
laser cannot even be reasonably approximated by the particular pulsed 
laser being used. The reason is one of insufficient power dissipating 
capability. To achieve an acceptable signal to noise ratio of laser to 
ambient light each laser pulse must be of a certain minimum power. This 
power level is large enough compared to the laser's power rating that the 
mavlmiiTn allowable ptilse rate must be kept low. Clearly, another method 
must be developed for bounding the terrain. Furthermore, the method must 
be kept simple given the additional constraint of limited computer support 
available to the R.P.I. vehicle. 
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V. DAT^ PROCESSOR FOR HAZARD DETECTION 

A method for processing laser data Is suggested by analyzing 
the raw data. In the typical return matrix from a single azimuth scan. 
Figure 14, each column represents the result of the firing of a single 
laser. The position of the number "1” In a column Indicates the detector 
that received a return after the laser pulse. The number "2" Is used 
Instead of "I" if the ret\im fell on level ground In the context of a 
vehicle fixed coordinate system. The ''3"'s are Inserted as a reference 
line Indicating the returns that would have been received if the terrain 
had been level. By taking the difference In position between the actual 
data and base terrain data, the measurements representing the terrain In 

3 

a given azimuth can be reduced to a diagonalized return. Figure 14, This 
set of data gives an indication of the level of the terrain above or below 
level ground. Application of the diagonalized return concept to the R.P.I. 
system defined earlier Is somewhat misleading. Notice Chat the line seg- 
ments of intersection fall into curved bands. Figure 15. The diagonalized 
rettxm concept would be more useful If the data fell into straight, horizon- 
tal bands that corresponded directly to the diagonalized return levels. 

Such a system can be achieved by proper choice of laser and detector point- 
ing angles. The particular detector system to be used, however, is con- 
strained to uniform spacing, A good approximation to horizourii *«veiu 
Is possible with evenly spaced detectors by aiming laser pulses at the 
center of Intersection of the individual detector fields with level ground. 
This modified arrangement which replaces the orlginsl system is defined as 
a quasi— linearized array. Figure 16, Notice that the uppermost laser pulses 
are of little use since they Intersect the detector field at too great a 
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range. For this reason, these higher elevation angles are omitted leaving 
13 laser pulses and 20 detectors. Figure 17. 

Scanning an arbitrary tei.,alo with the quasi-linearized array 
reveals that the terrain data are actually quantized by the roughly horizon- 
tal discrimination levels. Figure 18. Regardless of the contour of the 
terrain, each set of data maps the terrain Into a set of steps. Auy one 
of the possible patterns can be completely an*' uniquely described by the 
location and magnitude of the ‘ teps. 

Glve.'i the well defined patterns, a possible data interpreting 
scheme might be to associate a particular pattern with a particula ' terrain 
feature. There are some problems tc be dealt with if this idea is attempted. 
First, there is not a one-to-one correspondence between terrains and patterns. 
With an Infinite number of possible terrains but only a finite number of 
possible patterns, each pittem repre<^ents an infinite number of terrains. 

Even chough the set of patterns finite, there are very many of them. 
Attempting to match up c given data set vrith cne of a large set of st •;ed 
patterns can be a great bookkeeping and searching task. Finally, the ...asi- 
linearlzed array is by no means jniform. The pattern associated with a 
particular terrain feature varies with the relative position of the feature 
within the array. In spite of these difficulties, pattern recognition may 
still be a viable solution and is left open to other investigations. 

Before attempting to derive an algorithm to process sensor data 
for hazard detection, a clear and concise definition of a hazard must be 
developed. A generalized definition is desired for two reasons. First, 
the simpler the definition is, the simpler is the task of analyzing the ^ 
data for hazards. Second, the definition cannot be so specific tnat it 
requires more infornution than is available from the data. To obtain some 
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critr for identifying obstacles^ the vehicle*s nobility characteristics 
oust be considered t Fron tests it is known that the vehicle can cl imh a 
marl nun of a 30* slope and descend a -30* slope. The step clinibing ability 
is limited to a hei^t equal to the wheel radius of 0,25 " meters. It is 
assumed that the same limit applies to negative steps. Restating the 
above more simply, any feature whose vertical height exceeds 0,25 meters 
and whose slope magnitude exceeds 30* is a hazard. These criteria have 
been established for a vehicle on level ground but do not necessarily hold 
if the vehicle is pitched. When the vehicle*s inpath slope exceeds 20*, 
additional positive obstacles cannot be tolerated. An analogous- rule 
applies to the negative case. The crude xnles thtis presented form an 
initial point for investigation. The criteria .re simply defined and apply 
to all terrain features. 

Having defined what an obstacle Is, all that remains is to ex- 
tract the desired information from the available data, The test for 
critical height can be easily done since the array is organized into essen- 
tially horizontal height levels. There are, of course, restrictions to be 
placed on the site of the quantization bands. If the levels are chosen to 
be so large that they exceed the critical step height, then significant 
terrain features cannot be detected. By choosing the levels to be suffi- 
ciently small, a critical altitude change is revealed as a step change in 
the data. Thus, a relatively simple way of testing for possible obstacles- 
is to scan the diagonalized return for level changes. 

There Is, however, some ambiguity possible. Figure 19, While 
the figure shows two obstacles of different heights, the dlagnolized return 
is 


OOOiiiOOOOllll 



figure 19 


Tecxain d^ffepence$ not 'detected 
by diagonalized xijturn , 









and indln{^t38 tyq ol^jecta of Ixlentfced hejtghCt The cQAfsene&a of the 
quantization does not allow a better distinction. If the larger object 
is a hazard but the smaller object is not, then a serious problem exists. 

Any terrain perturbation, regardless of size, that crosses the boundary 
between two quantization and causes a level change in the diagonalized re- 
turn is an unsure case and must be classified as unsafe. Since the 
probability of any arbitrary but safe terrain crossing a quantization 
level is quite hi^, alirost all terrains would be viewed as hazardous. 

To remedy this situation the restriction must be inqiosed on the width of 
the quantization levels that a 0.25 meter teirrain rise will result in at 
least two level changes in the data. Unfortunately, it is difficult to 
meet this condition with the twenty detector array. Due to the geometry 
of the array the lasers, detector and discrlmlna..lon levels diverge 

as the distance from the vehicle increases. Figure 20. To impose the con- 
dition that the width of two adjacent discrimination levels be no more than 
0.25 meters even in the most distant areas of the array would require very 
narrow individual detector fields and thus, a prohibitively small overall 
field of view. The only alternative is to compromise by satisfying the 
condition only In the area near the vehicle. Figure 21. The restriction 
creates a very myopic vehicle that will accurately detect only large 
obstacles at large distances. Perception improves as the vehicle approaches 
until a range is reached where perception accuracy reaches desired levels. 

To insure that every terrain section is examined In the accurate area, the 
royer displacement between successive scans must be made sufficiently small. 

The Inherent discreteness of the array has so far been only a 
source of problems. Yet, there is one benefit derived from discrete data. 
The quantization of data "filters out" small terrain perturbations in much 






the same way that digital comunmlcation systems are useful In reducing 
noise In a signal. Only those features that are large enough to be 
possible hazards will show up In the data. Any terrain that falls entirely 
within a single discrimination level is safe and need not be scanned for 
hazards. This Is a big benefit since obstacles are autotoatically revealed 
without computational effort. 

Having addressed the problem of locating critical heights, the 
next step Is to find a method for determining slopes. The magnitude of 
a slope Is related to the spacing of level changes In the data, A rapid 
succession of level Junq>s suggests a steep slope while widely separated 
jumps cean a much gentler terrain. Unfortunately, the data levels have 
finite width so that a diagonalized return does not uniquely specify a 
single slope but, rather, a small range of possible slopes. Figure 22, In 
order to exactly specify this range of slopes, the upper and lower bounds 
must be computed. The upper bound Is useful because It represents the 
absolute worst possibility. This is important for a Martian vehicle since 
no risk can be taken, The lower bound Is useful for resolving some ambiguous 
cases and, thus, providing for better decisions. 

Suppose, for instance, that the range of slopes calculated for a 
particular terrain feature is 25® to 35®, A possible hazard exists since 
the maximum slope exceeds 30®, However, there is also the possibility that 
the terrain is safe since the slope could be as low as 25®, This case is 
asiblguous. Suppose now that slopes of 35® to A5® are estimated for another 
feature. The upper bound of 45® again indicates a possible hazard, In this 
case, though, the minimum slope also exceeds 30® indicating that a hazard 
definitely exists, A simple procedure for calculating the maximum and 
minimum slope estimates is presented here. Figures 23 and 24 have been in- 
cluded to aid In the explanation of the procedure. 
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FIGURE 24 
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Haxlmum Slope 

!• Determine that a possible height differential of 0.25 meters 

exists. 

2. Determine the coordinates of the lower endpoint of the first 
line segment after the first jtimp and the higher endpoint of 
the last line segment before the last jump. 

3. Compute the slope using these two points. 

4. For negative features, select the same line segments but use 
the opposite endpoints. 

5. If multiple or consecutive jumps occur, select the lower end- 
point of the line segment before the jump and the higher end- 
point of the line segment after the jymp. 


Minimum Slot-a 

1. Determine that the least possible height differential exceeds 
0.25 meters. This is done to make sure that any slope calcu- 
lated rises above 0.25 meters. Otherwise, the slope is not 
hazardous regardless of how steep it is. 

2. Determine the coordinates of the higher endpoint before the 
first jump and the lower endpoint after the last jump. 

3. Compute the slope between the two points. 

4. For negative features, select the lower endpoint before the 
first jump and the higher endpoint after the last jump. 

5. The procedure does not change for multiple or consecutive 
jumps. 


These methods yield the least and greatest slopes possible that 
intersect every line segment in the area in question. They are also easily 
implemented. The locations and magnitudes of level Jumps are known from 
the dla: nallzed return. The endpoints of all line segments in the array 
can be computed by geometry and stored for easy access when needed. Since 
the slope calculations involve just two points, the arithmetic is minimal. 

So far, the step and slope criteria for obstacle detection have 
been considered. The remaining case is the decreased climbing capability 
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when the vehicle pitch exceeds + 20*. This test Is easily done because 
the vehicle attitude Is readily available from onboard gyros. If the 
vehicle pitch exceeds 20*, then any positive Jumps are assumed Impassable. 
Similarly, negative jumps are Impassable If the pitch is less than -20*. 

All of the obstacle criteria defined earlier have now been 
treated. There is, however, another possibility to be (. onsldered. It Is 
possible that a laser shot will not be seen by any detector. This can 
occur if the scattered light is blocked by an obstacle before it reaches 
a detector. In this case, no data is received and It must be assumed that 
a deep crevasse exists. Fortunately, missed returns provide some informa- 
tion. Based on the number of consecutive missed returns the size of the 
hole can be estimated. If the hole is large enough for a wheel to fall 
into, then the path Is unsafe, Figure 25. However, just because the gap 
Is small, safety is not guaranteed. Several missing returns can also 
signnlfy a sharp, hazardous drop. To account for this possibility, the 
difference in terrain height before and after the missed returns Is computed, 
Flgxire 26. Of course, when the missed returns occur at either end of a scan, 
the height of the terrain Is not known on both sides of the missed data. 

If the closest laser shots are not seen, then the vehicle Is close to .i 
potential obstacle but can no longer see the entire feature. To deal with 
this case. It Is assumed that the whole feature was seen In a previous scan. 
Since past scans ’id not detect an obstacle, the terrain Is considered snfe 
In spite of missed returns. Missed returns can also occur at the far end 
of the scan. This possibility raises another Important Issue, Ofteu a 
possible obstacle is detected at a distance but there Is insufflc: in- 

formation to make a definite decision. In the case of missed returns, a 
single one at the far end of a scan may signal the leading edge of a 
crevasse or just a small, traversable depression. An example of another 
ambiguous case occurs when a distant object Is detenplned to have a range 
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FIGURE 26 

Interpretation Qf small number of missed returns 
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of slopes from 2S* to 35*. In both of the above cases > caution should 
be exercised since the terrain is potentially hazardous. To turn away 
immediately, however, is not a good idea because many false alarms can 
occur. This is particularly true due to the poor accuracy of the data 
at long distances. The obvious solution is to get closer and to take a 
better look. The R.P.I. vehicle has a scan rate fast enough to give five 
different views of the same terrain as the vehicle approaches. Taking 
five scans increases the chances of resolving the asibigulty. Naturally, 
there is a limit as to how closely the vehicle can safely approach an 
obstacle. In this system, the limit Is set at 1.4 meters. The strategy 
is, therefore, to approach an obstacle until either a definite decision is 
made or until the obstacle is wit! in 1.4 meters in range. 

Until now, all of the obstacle detection has been done in the 
vehicle frame of reference. The reason for doing the analysis this way 
is sinq>llcity. The coordinate transformations required to convert the 
data from the vehicle to the planet frame require additional calculatlonal 
effort and time. After that has been done, the benefits of the horlzcntal 
quantization levels are lost. However, the step and slope climbing ability 
are related to gravitation and only have meaning in the planet frame. The 
solution is to convert all of the computer terrain slopes cu the * lanet 
frame by simply adding in the vehicle attitude. This is much simpler and 
faster than doing the transformation before the slopes are computed. 

The hazard detection algorithm is now complete and a general 
flow chart appears in Figure 27. 
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General flowchart for hazard detection 
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V. SnOJLATION PACKAGE 

The multl-laser/detector trlangulatlon sensor and the accompanying 

hazard detection algorithm are to be tested using the R.P.I. dynamic slmu- 
4 

lator . The dynamic simulator is the result of several years of effort 
and accurately represents the scanning, decision making, and notion of the 
actual vehicle on specified terrain surfaces. The user can choose from among 
a nusd>er of a'^^ilable general terrain surfaces including slopes, hills, and 
sine waves. Discrete obstacles such as boulders, craters, and steps may be 
added to the general terrain surface. There is also the provision for 
simulating rubble and small rocks on the surface as a noise function. 

The user may also choose from a variety of sensors and is free to 
specify the placement, size, and geometry of each. There is a choice of 
data processors and path selection algorithms to interface with the various 
sensors. The measurements made by the sensors can also be contaminated by 
noise if so desired. The user can also control the physical dimensions and 
dynamics of the vehicle. 

After the user specifies the initial and target locations, the 
simulation package takes over. Sensor scans are taken at user prescribed 
Intervals after vehicle attitude information from the gyro subroutine adjusts 
the sensor position position. A terrain model is developed and the best 
path is selected based on the vehicle’s position relative to the target and 
the surrounding hazards. Control then passes to the motion routine and the 
vehicle is moved at a rate and for a duration given by the user. The cycle 
then repeats after this point. 

The simulation terminates when either the target is reached, the 
allotted time is exceeded, or the vehicle finds no safe paths available. 

At this time, the performance is evaluated be-* on path length, trip 



duration, and tha numbar of cloaa ancQuntara ttasarda^ Penally* 
maps ara printad out showing tha tarraln and thi' vahlcla trajectory 



VI. SDflJLAIIONS AND RESULTS 


Four groups of simulations have been conducted each designed 
to test the sensor's ability to detect various obstacles under various 
conditions. These are suamarlsed in the table below. 


Simulations Performed 


I. Vertical Steps 

A. 0.2 meters high 

B. 0.3 meters high 

C. 0.4 meters high 

II. Smooth Slopes 

A. T^nty degrees 

B. Twenty^flve degree magnitude 

1. Positive slope with 15 laser, 20 detector system 

2. Positive slope, same sensor but field of view aimed closer 

3. Negative slope, original system 

C. Thirty degree slopes 

1. Original 15 laser, 30 detector system 

2. 25 laser, 30 detector system 

3. 32 laser, 40 detector system 

III. Sine Waves 

A. 0.25 meter amplitude, 6,0 meter period 

B. 0.3 meter amplitude, 6.0 meter period 

C. 0.4 meter amplitude, 6.0 meter period 

IV. Boulder. and Crater Field 


In the first group of simulations, vertical steps of various sizes 
are placed In the vehicle's path. The purpose of these tests Is to deter- 
mine the vehicle's ability to detect changes in terrain elevation. When a 
change in height of 0.25 meters is detected, the slope of the leading edge 
of the step Is compute! . No calculations are done for small steps. The 
smallest step size worth considering is 0.2 meters. According to the 
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algorithm, an object must create a change of two levels in the diagonali- 
zed return before it can be considered hazardous. A drawing of the 15x20 
array shows that this does occur when a 0.2 meter step is within a 1.4 
meter range. Figure 28. The simulation verifies this. Initially, only 
zeroes and ones appear in the diagonalized rettim and the terrain is con- 
sidered safe. It is not until the scan at one meter range that returns 
occur in the second level. A slope of 98* is calculated for the leading 
edge and the feature is declared hazardous. Figure 29. Ideally, the path 
should have been declared safe since the obstacle is below the 0.25 meter 
threshold. It is the discreteness of the data, not a defect in the data 
processor that prevents making a more accurate decision. Given the data 
received the step could have been as high as 0.35 meters or as little as 
0.1 meters. Since the error is due to the finite width of the quantiza- 
tion level -, making them smaller is the best way to improve performance. 

Steps of greater height are also considered. Obviously, these 
will be d~'tected as hazardous. What is of Interest is to note at what 
range the decxslon to avoid the obstacle is made. Due to myopia, the 
vehicle will see only larger objects at a distance and the smaller ones 
up close. For a 0.3 meter step, a possible obstacle is detected at 2.2 
meters range. However, the data are not good enough at that point to know 
for certain that a hazard exists. The criterion for such a decision is that 
the m-lnimiim possible change in elevation be at least 0.25 meters. This 
never happens, though, and the vehicle continues to approach until it 
reaches 1,0 meters range. Even though the ambiguity 5.s not resolved, the 
vehicle must turn due to the close proximity of the obstacle. 


The last run in this group is a 0.4 meter step. A possible hazard 
is detected at 2.5 meters range. Again, the data is not good enough to 
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make a decision. The vehicle proceeds until at 1.9 meters range a in‘tn<miim 
step of 0.25 meters is detected. The calculated maxlimim and minimum 
slopes are 105^ and 60", respectively. Steps whose heights exceed 0.4 
meters will be declared definitely hazardous on the first scan. This 
would occtir at about 2.5 meters in range. In summary, anv obstacle at 
least 0.2 meters in height is avoided by the vehicle. This includes features 
from 0.2 to 0.25 meters high that in reality are safe. Large obstacles are 
seen and avoided at greater ranges than smaller obstacles. The limitations 
stem from the quantization error inherent in the system. The best way to 
improve performance is to increase detector density by adding more de- 
tectors and reducing the field of view of the individual detector. 

The next group of simulations tests the ability of the algorithm to 
estimate the magnitudes of smooth slopes. The first run at 20" is used to 
demonstrate the performance for an easy case. The vehicle begins on 
horizontal ground and approaches the slope head on. At 1.8 meters enough 
information is available to estimate a maximum slope of 39" . As the 
vehicle approaches, the estimates improve until at the 1.0 meters range 
the slope is estimated to lie between 17" and 25 ", I*igure 30. The slope 
calculations for the off center azimuths indicate less severe slopes since 
those gradients are not as steep. For Instance, in the 30" azimuth the 
true gradient is 17.3" and the processor computes the maximum slope as 18". 
Also of note is that the minimum slope calculations are generally more 
accurate than maximum slopes. The reason is that minimum slopes must be 
computed over longer ranges. This helps average out some statistically 
bad data. 

As the vehicle continues to approach the 20" slope, the estimates 
do not improve appreciably. The maximum slope never exceeds 25", though, 
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and Che vehicle Is allowed Co climb* As chls occurs, a sceadlly decreas- 
ing slope magnlCude is perceived. AfCer correccing Che slope escimaCes 
for Che vehicle acclcude, Chey are similar Co Che esClmaCes obcalned on 
level ground, demonscratlng ChaC accurace esclmaCes can be made when Che 
vehicle has an arblCrary plCch. When Che vehicle plcch approaches ChaC 
of Che slope, Che perceived slope is so small Chac no pocencial hazards are 
deCecCed^ Figure 31. In Chls sicuaclon chere is less chac can be said 
abouC Che Cerraln Inclination The reason is ChaC Che change in Cerrain 
elevacion seen by Che vehicle is less than 0.25 meters. Therefore, no 
slope escimace is obcalned. In this case, Che vehicle assumes that if its 
inpach slope is less chan 20**, any Cerrain Chat lies ahead is safe. The 
vehicle Chen proceeds Co climb completely onto the slope at which point it 
sees flat Cerrain everywhere. In chls case, Che assumption made as to Che 
safety of Che Cerrain is correct. The program ignores ocher possibilities. 
Chough, where the logic breaks down. Suppose the vehicle is traveling 
across the face of a 30® slope. Figure 32. The InpaCh slope is 0* while 
the crosspach slope is 30®. If a small terrain feature appears on the 
vehicle's high side, Che path in which it lies is considered safe. The 
reason is Chat as in Che case above, the vehicle inpach pitch is less than 
20®. However, if Che vehicle chooses that path, it will be traveling up 
a gradient in excess of 20®. The vehicle can tolerate absolutely no 
obstacles in chls case and the Cerrain is actually hazardous. A simpler 
example Involves the vehicle climbing a 40® slope at a 45® angle. The 
Inpach gradient is 28® and safe. Suppose Che vehicle wants Co make a -45® 
Cum. The scan shows flat terrain and Che turn is allowed. In reality, 

Che path chosen has a 40® gradient. To correct this problem, Che vehicle 
roll must also be accounted for. From pitch and roll information the plane 
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FIGURE 31 

Diagonalized return for 20’ slope, vehicle pitch 10.4* 
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In uhlch the vehicle lies can be determined. It Is then an easy matter 
to find the Inclination In any azimuthal direction by taking the dlrec 
tlonal derivative. In this way» the estimated slopes can be pr<. / 
corrected for vehicle attitude. 

To test the vehicle under more challenging conditions, a 25** 
slope Is attempted. The first slope estimates of 41* occur at 1.8 meters 
range. As with the 20* slope, the estimates Improve until the vehicle Is 
within 1.0 meters. At this range the computed slope range Is from 21* to 
34*. This range of slopes Is greater than for the 20* case. Steeper sJopes 
are generally predicted less accurately than gentler ones. The reason can 
be determined by observing the data for both cases. Figure 33. With steep 
slopes the level jumps occur closer together and allow a greater range of 
slopes. Fiirthermore, negative slopes are estimated more accurately tha ‘ 
positive ones. This happens because negative slopes are nearly parallel 
to the laser shots. Figure 34, and allow only a very small slope variation. 

A test on a -25* slope reveals that the slope estimates have a much 
smaller variance than in the 25* case. This does .lot mean that, in general, 
negative terrain Is perceived more accurately than positive terrain. This 
Is only a special case of smooth slopes. The data in the lower area of 
the terrain Is very poor and should result In poor estimates for arbitrary 
negative obstacles. 

Returning to the 25* simulation, the computed slope range of 21* to 
34* in the center azimuth forc“s the vehicle to change course. It must 
*mb the slope at an angle so that the gradient Is less steep. Once the 
vehicle is completely on the slope. It sees level ground and Is able to 
resume Its original heading. Figure 35. It Is disappointing to see that a 




\ 

A 




Exas9{»le of greaC^r deviations possible with steeper slopes 






25* slope cannot be climbed head on. This vould be possible if the 
data were made more accurate. One way of doing this Is to move the 
field of view in closer. This concentrates the same number of laser 
shots Into a smaller area. To test the effectiveness of such a modifi- 
cation another 25* run is done with the 15x20 array, lhi.3 time the 
field of view Is moved in so that the first laser pulse strikes level 
ground at 0.6 mater as opposed to 1,0 meter previously. As a result » 
the vehicle must now approach even closer to get a good view, With the 
modified array, no slopes are calculated until the vehicle is within 1.0 
meters. At this point the Initial estimate is 34* as compared to 41* 
for the Initial estimate for the first case. However, that 41* estimate 
was made at 1.8 meters range. The previous system predicted a slope of 
21* to 34* at the 1.0 meter range. This is the same maximum slope 
predicted by the modified array at the same distance. The estimate from 
the modified array improve as it approaches while the original system 
gave practically the same estimates. At 0.6 meter the computed slope is 
31*. This is 3* better than the original system. Hence, the vehicle 
must still turn since the 30* threshold is exceeded. The conclusion is 
that, at least for sc "fh slopes, no noticeable improvement results from 
moving the field of v.> in closer. 

Returning to the original 15x20 system, a 30* slope is now attempted, 
Of course, there is no way that the vehicle can climb this slope head on. 
The simulation is, therefore, done with the vehicle attempting co climb 
at a 40* angle. Systems with 25 lasers x 30 detectors and 32 lasers x 40 
detectors are also tested on the same path as the 15x20, This is done 
to determine the effectiveness of increasing data density and .accuracy. 

The results are shjwn in Table 1, 
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TABLE 1 

COMPARISON OF DIFFERENT SENSOR SYSTEMS 
VIEWING 30** SLOPE 


Range to start Slope estimates (degrees) 

of slope (m.) 15x20 25x30 32x40 


1.8 



86 

43 

85 

38 

83 


43 

40 

40 

84 

38 





— 

26 

25 

26 



26 

29 

25 

25 



1.5 

45 

84 


42 

43 

84 

40 


47 

44 

33 

32 

40 

83 


28 



28 

27 

27 



28 

27 

25 

27 



1.2 

32 

43 

82 

52 

30 

83 

42 

41 

33 

37 

35 

34 

34 

34 


23 

29 


28 

27 

29 

26 


27 

27 

26 

26 

27 

26 

1.0 

54 

32 

44 

38 

39 

37 

45 

44 

43 38 

30 

32 

37 

36 

31 


25 

24 


28 

29 

28 

29 

28 

28 

28 

27 

27 

28 

27 

0.7 

51 

47 

32 

39 

38 

32 

32 

45 

34 

33 

36 

35 

32 

33 


28 

26 


30 

27 

28 

27 


■^0 

?8 

30 

29 

28 


0.4 

48 

43 


33 

33 

33 

34 

35 

35 

33 

31 

32 

32 

33 


26 



28 

28 

28 

29 


29 

28 

28 





Two sets of slope estimates are given of each location for each system. 

The maximum estimates are on the upper line and the minimum estimate : 
are on the lower line. 

Multiple estimates are given of each location because the estimates 
correspond to different sections of the same terrain. They are arranged 
in increasing order of range. 



The effect of additional lasers and detectors is quite notice- 
able. With all three systems, the maxiimm slope estimates always over- 
estimate the true slope while the ntinimiiiii estimates always underestimate. 

The difference is that the amount of variation in the estimates is greatly 
decreased when greater data density is used. Unfortunately, even the 
finest array gives some statistically bad data, even at close range. 

Bowever, the probability of receiving statistically bad data is much lower 
than with the 15x20. A common way of dealing with statistically bad data 
is to nse filtering or smoothing techniques. This usually requires many 
measurements of the same signal or object. Even though the laser scanner 
does iu>t generate a large quantity of data, some first approximations can 
be made. The higher order systems, such as 25x30 make several slope 
estimates over a short section of terrain. If the terrain is assumed not 
to vary greatly. over small distances, then some smoothing can be done. As 
an example. Figure 36 lists slope estimates obtained from a 25x30 sensor 
system scanning a 30° slope. All of the estimates are based on data from 
a single scan. Each estimate represents only a small section of the slope 
fuid the estimates are printed in order of Increasing ran.r^. In the -60° 
azimuth, the 39° estimate is the closest and Is based on “he most accurate 
data. However, Ic is also the least accurate estimate of the five calcu- 
lated in that azimuth. The other four estimates are very consistent and 
cast doubt on the validity of the 39° estimate. Furthermore, the range 
of the 39° estimate partially overlaps the range of the adjacent 32° estimate. 
For these reasons, the inconsistent estimate should not be counted as heavily. 

In this example, the slope is still hazardous even if the 39° 
estimate is ignored. There may be ether situations in which this technique 
would have a greater effect, 
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OIAGCNALIZEO RETURN 
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6 

7 

3 
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14 
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444 ' * 
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3 

2 
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0 

■ 0 
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0 

24 
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444 
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5 

3 

2 

0 

0 

0 

0 

0 

23 

449 
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444 
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7 

7 

6 

4 

3 

1 

0 

0 

0 

0 

7 

22 

7 

8 

8 

8 

7 

6 

5 

4 

3 

1 

0 

0 

0 

0 

0 

21 

7 

7 

8 

7 

7 

6 

5 
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1 

0 

0 

0 

0 

0 
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AZIMUTH ANGLE -70. DEGREES 


MAX 

SLOPE! DEG) 

35. 

33 . 32. 32. 

32. 


HI N 

RANGE(M) 

1*0 

1.1 1.3 

1.5 

1.6 

MAX 

RANGE ( M ) 

1*2 

1.4 1.5 

1 .8 

1 .8 

MIN 

SLOPE! DEG) 

26. 

27. 26. 26. 



MIN 

range !M) 

0#9 

1 .1 1 .2 

1 .4 


MAX 

RANGE! M) 

1*5 

1.6 1.9 

1.9 
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-60 • DEGREE* 
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SLOPE! DEG) 

39. 

32. 32. 33. 

33. 
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RANGE! Ml 

1.1 
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1.5 

1.7 
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RANGE! Ml 

1 .3 

1.5 1 .6 

1 .9 

1.9 
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SLOPE! DEG) 
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27. ~ 27. 27. 

■ — 

■ - 
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RANGE! M 1 

1.0 

l.l 1.3 

l.S 


MAX 

RANGE! Ml 

1 .5 
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AZIMUTH ANGLE 
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RANGE!M) 
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1 .2 1.3' 

1 .5 

1.7 

MAX 

RANGE! M) 

1.3 

l.A 1.6 

1 .6 

1 .8 


FIGURE 36 





25x30 System, 30* slope; example of inconsistent estimates 
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A technique that will yield better results is to filter data 
from several scans. Table 2 shows ^^ulv^ 1 nll 1 n and minimum slope estimates 
obtained over six consecutive scans made by a 32x40 system as the vehicle 
approached a 30* slope. Along with each estimate is the location relative 
to the vehicle of the terrain associated with that estimate. In Table 3, 
the estimates are regrouped by location relative to the planet. Note that 
there are several slope estimate at each location. Each maximum slope 
estimate always overestimates the slope vdille each minimum always under** 
estimates. Clearly, the best estimates are the least maxima and the great- 
est minima for each location. These estimates have been selected and 
placed in Table 4. These "filtered” estimates are a much more accurate 
representation of the terrain than any set of estimates from a single 
scan. 

The benefits obtained from this technique must be weighed against 
the computational effort required for implementation. The coordinate 
transformation of the estimate locations from vehicle to planet frame is 
easy with a straight trajectory as in this example but is much more 
complicated otherwise. Furthermore, in this example the estimate locations 
were given as points. In reality, the estimates are taken over finite 
ranges of the terrain and often the ranges from consecutive estimates will 
overlap. Finally, in the example above, only data from the center azimuth 
are considered since those scans overlap when the vehicle is on a straight 
trajectoiry. The data obtained from off center azimuths do not overlap as 
much as in the 0* case. A more sophisticated algorithm would be needed to 
deal with this. Even with a complex algorithm, the best results will be 
obtained in the center of scan. The implications are that the resulting 
system will have better central visiion than peripheral vision. Actually, 
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TABLE 2 

32x40 system, 30* slope 

Uaximum, olnimum slope estimates and corresponding range estimates 


Vehicle Location 
Planet Frame 
(meters) 


Slop estimated (degrees) 
Range estimates, vehicle frame 

! (meters) 

-1.8 

Max 

43 

40 

40 

84 

38 



Range 

1.9 

2.1 

7.2 

3.4 

2.6 



Min 

26 

29 

25 

25 




Range 

1,8 

2.0 

2.1 

2.3 



-1.5 


472 

44 

33 

32 

40 

83 



1.6 

1.8 

1.8 

2.0 

2.2 

2.5 



28 

27 

25 

27 





1.6 

1.7 

1.8 

1.9 



-1.2 


33 

32 


34 

34 

34 



1.3 

1.5 

1.6 

1.7 

1.9 

2.0 



27 

27 

26 

26 

27 

26 



1.3 

1.4 

1.5 

1.6 

1.8 

2.0 

-1.0 


38 

30 

32 

37 

36 

31 



1.1 

1.1 

1.3 

1.4 

1.5 

1,6 



28 

28 

27 

27 

28 

27 



1.0 

1.1 

1.2 

1.3 

1.5 

1.5 

-0.7 


34 

33 

36 

35 

32 

33 



1,0 

1,1 

1,2 

1.3 

1,4 

1.5 



30 

28 

30 

29 

28 




1.0 

1.0 

1.1 

1.2 

1,3 


-0.4 


33 

33 

31 

32 

31 




0,9 

1,0 

1.1 

1,2 

1.3 




29 

28 

28 






0.9 

1,0 

1.0 





41 

2.2 


36 

1.8 
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TABLE 3 

32x^0 syscem, JO* .slope 
Slope estimates from six consecutive 
scans grouped by planet frame location 


Terrain Location 

Planet frame Haxlmuni Slope Minimum Slope 

(meters) Estimates (degrees) Estimates (degrees) 


0.0 





0.1 

43 

47 

33 

38 

0.2 





0.3 

40 

44 

33 

32 

0.4 

40 

35 

37 

33 

0.5 

32 

34 

36 

36 

0.6 

84 

31 

35 

33 

0.7 

40 

34 

32 

31 

0.8 

38 

34 

36 

33 

0.9 

31 




1.0 

83 

41 





26 

28 




30 

28 

27 

28 




29 

27 

27 

27 


32 34 

25 

25 

26 

27 

30 


27 

26 

30 



33 

25 

28 

27 

29 

29 


27 

28 

28 

28 



32 26 
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TABLE 4 

32x40 ^y^ten, 30* slope 

Best slope estimates obtained from 
six consecutive scans 


Terrain Location 
Planet Frame 
(meters) 


Least Maximum 
Slope Estimate 
(degrees) 


Greatest Minimum 
Slope Estimate 
(degrees) 


0.6 

- 

28 

0.1 

30 

28 

0.2 

- 

29 

0.3 

32 

30 

0.4 

33 

30 

0,5 

32 

29 

0.6 

31 

28 

0.7 

31 

- 

0.8 

32 

26 

0.9 

31 


1.0 

41 

- 


this is not necessarily a problem at all since the human eye behaves 
In the same way. 

All of the drawbacks listed above can be overcome at the cc^^t 
of Increased computer time. Only further study will tell whether or not 
the additional computing Is Justified, In theory, the Idea has merit 
because It makes use of all of the data available. With a system as crude 
as the one studied here, discarding even a small amount of data can sub- 
stantially degrade results. The technique has the further advantage that 
the estimates are done recursively. This greatly reduces the effort re- 
quired as opposed to storing all of the data In a constantly updated map. 
Much more storage and calculating time are required with the map method. 

Returning to the comparison of the ^hree simulations on 30** slopes, 
increased data density does provide better estimates. Better estimates 
result In more accurate distinctions between safe terrain and hazards and 
allow the vehicle to travel a more direct course towards its target. In 
the simulations, the trajectory followed for the 32x40 is steeper than with 
the 15*20, Figures 37 and 38. Furthermore, the trajectory for the 32x40 
could have been steeper still if the vehicle had not been constrained to 
a heading of 40’. The performance of the 15x20 system is nonetheless, 
admirable. Slopes from -20* to +20® are negotiated with absolutely no 
problems. More severe slopes can also be handled but the vehicle must 
approach at an angle. The amount of uncertainty inc -eases with increasing 
slopes so that steering commands become more erratic. 

Another group of simulations places the vehicle on sinusoidal 
terrains of varying amplitude. The purpose is to test the ability to deal 
with a variety of constantly varying terrain situations. While the results 
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look good, they are more difficult to Interpret quantitatively than the 
previous simulatioas. This is primarily due to the fact that it is diffi- 
cult to imagine what the vehicle sees during a scan under arbitrary pitch 
and roll conditions. Also, an error has been found in the simulation sub- 
routine that adjusts the sensor attitude for vehicle roll. Subseque&u 
simulations will be affected to some degree by this defect. 

Three simulations are performed on a sine wave with 6.0 meter 
period and amplitudes of 0.25, 0,30, and 0.40 meters. These are chosen 
to duplicate simulations performed earlier to test the previous one, two, 
and three laser/detector systems. ^ In all cases the new 15x20 system per- 
formed as well or better than previous systems, as would be expected. The 
run for 0.25 meters amplitude poses no problem at all as the vehicle is 
able to travel a direct heading. The maximum computed slopes are +22* 
which C( spares to true maximum lonl slopes of +14,5*. 

The 0,3 meter ar-plltude case reveals an additional problem. The 
primary source of trouble is a small field of view. As the vehicle scans 
down from a crest into a trough, the closest laser shots are not seen be- 
cause the terrain falls below the detector field. Figure 39, The algorithm 
is set to Identify four or more consecutive missed returns as an obstacle. 
It is total lack of data, not poor data, that causes the vehicle to turn. 
Laser shots are also missed at the far end vhti. certain rises rbove the 
detector field. This occurs especially when tae vehicle is pitched down- 
ward. 

The ;^roblems with missed returns become more pronounced rn the 
O.s meter case. It addition to laser shots hitting outside of the detector 
field, the terrain falls off so quickly nor (maximum of +22,5*) that some 
laser shots aimed into troughs are blocked by the slope. Figure 40, While 
the number of missed returns due to this is not sufficient to be hazardous, 
greater amplitudes will no doubt be Impassable as this effect will worsen. 









Furchermore, the maxlaina slope estlnates at close range are approaching 
30* and are Just barely acceptable. In spite of this, both the 0,3 and 
0,4 Bieter cases are traversed with nearly straight trajectories. Figure 
41. Since the trajectories are almost straight, the vehicle roll is 
Is small and the error in correcting the scanner altitude is, likewise, 
small. The simulatloa results are, therefore, reliable. 

The last slsnilatlon tests the 15x30 system on a field of 
shallow boulders and craters. Figure 42. Most of them are small e- ongh 
that they can be safely traversed. They are merely added t j * 
terrain uneven and cause variable pitch and roll sltuatio* 
hazardous boulders and craters are interspersed and they be detected 

from among the other features. 

The vehicle performs well and is able Co traverse Che boulder/ 
crater field without mishap. On the first two scans hazards are detected. 
This comes as a surprise since the terrain was intended Co be safe at that 
point. What is seen is a 0,15 meter deep crater adjacent to a 0,15 meter 
boulder. The features are safe when considered separately. When put 
together, though, the combination yields an average slope of 20® over a 
0,25 meter rise with a maximum instantaneous slope of 37®, This compares 
to predicted slopes of 34®-36®, It is possible Chat the algorithm made 
the correct, though unexpected, decision. A sharp turn follows and the 
vohlcle makes a successful attempt to enter the field at another point. It 
proceeds cn a direct course toward Che target passing alongside a 0,25 
meter deep crater. Contrary to expectations, the crater is not considered 
hazardous by the vehicle. Again there is a problem as to how the feature 
should be interpreted. With a depth of 0.25 meters, a maximum local slope 
of 48®, and an average slope of 18,5" from edge to center, it is not clear 
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yhfttbex o» not the cxs^tex iA hftzj^rdoua hy the given Algorithm, Thle la 
especially true since a local slope cannot be determined the scanner. 

The decision is made more difficult considering the vehicle's distance 
from Che crater and its pitch and roll situation. The fact that Che 
vehicle has some roll casts some doubt as to the validity of the results. 
Interestingly, the crater is definitely not hazardous cause of its small 
size compared to the vehicle dimensions. If the vehicle were to pass 
through the crater, it would experience a maximum pitch of 7' and a maximum 
roll of 9,5°, Of course the present algorithm Is not expected to take 
these considerations into account, A more sophisticated algorithm is 
required Chat estimates the vehicle's expected pitch and roll instead of 
or in addition to the terrain slope. 

The question as to whether or not the 15x20 system considered 
the 0.25 meter crater hazardous has not been answered yet, The only way 
to get the answer is to repeat the simulation after correcting the program 
for the roll adjustment error, What this simulation does demonstrate, 
though, is that Che question of defining a hazard is by no means crivial. 
More work must be done to extend the simple rules developed here. 

In all of the simulations, the 15x20 system with the hazard 
detection algorithm is able to steer clear of all obstacles. Unfortunately, 
some safe terrain is also avoided. This is necessary since all ambigv. . 
cases must be treated with caution. It was seen that one of the best ways- 
of improving the performance is to increase data density and accuracy' hy 
going to higher order scanning systems. The number of bad estimates is 
reduced thereby minimizing the variation of computed slopes. Just as 
important is the accuracy of the data interpreter. The algorithm developed 



is qulce reliable since it makes use of all of the data available in a 
scan and attempts to account for all possibility however, the decisions 
made are based on some oversimplified assumpti^'as ^nd techniques and could 
stand some improvement. It must be stressed that this is not disastrous 
since the assumptions lend to make the algorithm more conservative in 
decision making. While the algorithm does use all of the data taken in a 
scan, it ignores data taken from previous, overlapping scans. No doubt 
the additional information would be helpful but the tradeoff Is a much 
more time consuming program. 

Even with the dif ficxilties mentioned above, there is absolute 
confidence in the slope estimates. Not once did the true terrain slope 
lie outside the bounds predicted by the mavlTmtin and minimum slope calcula- 
tions, Sometimes this is hard to ascertain since the estimates are only 
averages taken over a finite range Interval in which the terrain slope is 
varying. Furthermore, the maximum slope estimates are usually computed 
over a shorter range than the minimum slopes. As a result, it is sometimes 
difficult to attach physical meaning to the estimated range of slopes when 
the upper and lower bounds do not represent the same terrain. Figure A3, 

The estimates are still no less correct in spite of this. 

Another potential problem demonstrated by the simulations is in- 
adequate field of view. With a small field of view, there will be times 
when absolutely no information is received about a section of terrain, 

This is particularly dangerous when the area in question is very close to 
the vehicle. The only decision a cautious vehicle can make when no informa- 
tion is given is to choose another path, This is an unnecessary hindrance 
to the vehicle, The additional lasers and detectors needed to cover the 
entire field of view vrould be a worthwhile modification. Assuming the 






vehicle will never have a pitch in exceaa of +30*, a 60* field of view 
is recooDoended. At 2* per detector, this requires an additional ten 
detectors. Given a fixed munber of detectors, the field of view problem 
is a tradeoff between adequate peripheral vision and ucurate center 
vision. Expanding the field of view without adding additional detectors 
degrades the data overall. One solution might be to concentrate most of 
the laser shots and detectors directly in front of the vehicle. This 
would insure that one very accurate scan can be obtained. To deal with 
the peripheral vision problem, additional lasers and detectors with 
greater spacing could cover the fringe areas. These would be used mainly 
to signal a major shift in the terrain. If the terrain rises or falls 
greatly or if the vehicle is pitched, the scanner can be rotated so that 
it again focuses on the ground Imnediately in front of the vehicle. 
Naturally, this would require a degree of sophistication that has not yet 
been reached with the R.P.I. rover. However, the idea is by no means un- 
realistic. 

There is one great limitation with the hazard detection algorithm 
that has not ever been considered in this paper. This data processor was 
designed to Interpret data in a single azimuthal scan. Unfortunately, 
gradients occur in all directions and these are totally oVerlogkedl^-lt ^ 
entirely possible to have safe slopes in the Inpath direction but hazardous 
slopes in the crosspath sense. Figure 44. This happens, for Instance, when 
the vehicle travels across the face of a slope. One way of dealing td.th 
the problem would be to try to estimate crosspath infoimiation from inpath 
slopes. As an example, suppose a 20" slope is indicated one azimuth while 
an adjacent one is estimated at -20", It is apparent that while both paths 
are safe in the Inpath sense, a .larp change occurs in the crosspath direc- 
tion. This technique, though, is qualitative at best and gives much more 
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Vehicle Attitude and Cross^ Considerations 


emphasis to the Inpath interpretation. There is no reason to believe 
that the inpath slope is any more important than the crosspath slope. 

To give equal treatment to the crosspath case, the algorithm used for 
the inpath data can also be applied to data perpendicular to the path. 

The main problem with this solution is that except for very close ranges, 
the data desisity in the crosspath sense is less than in the azimuths. 
Terrain interpretation would be difficult. This can be remedied by tak- 
ing the azimuth shots at increments smaller than 10**. To maintain the 
same 150" sweep, this requires more azimuths, more data, and more proces- 
sing time. Another alternative is to make the azimuth shots closer 
together but to use the same nuniber. This concentrates them in a much 
smaller area. The center vision is again improved at the expense of 
peripheral vision. It would appear that the tradeoff is worth It since 
the terrain immediately in front of the vehicle is of the greatest con- 
cern. If a sharp turn is required, a scan in the new direction can be 
made before any action is taken. 

The hazard detection algorithm presented !• n does have some 
weak areas that require further study. Most Importai.t among these are 
the need for crosspath slope information and a more refined conception 
of what an obstacle Is. The main purpose of this Investigation, however, 
wau CO determine whether or not a multl-laser/detector trlangulatlon 
hazard sensing system is feasible. This has been accomplished. Despite 
resolution problems, reasonably accurate terrain characterizations have 
been made using the R.P.I. system. More Importantly, reliable bounds 
have been placed on Che terrain estimates. It is for this reason that 
the R.P.I. rover never found itself In a dangerous situation and this Is 
an important consideration when planning a Mars mission. Without the 



hardware constraints limiting the R.P.I. system, increased resolution 
and performance are possible with a trlangulatlon sensor. Increased 
laser density Increases the quantity of data and finer individual 
detector fields improve the accuracy. The amount of information avail- 
able from the data, however, is a function of the spacing of both the 
lasers and detectors. Furthermore, it is, in theory, possible to extract 
the maximum amount of information available from a given sensor and to 
easily construct an accurate envelope enclosing the terrain. Even with 
the limited data and large uncertainties characteristic of the R.P.I. 
system a short range multi- laser/detector trlangulatlon sensor, by virtue 
of its speed, can compete with larger range sensors. This work serves 
as a basis for further investigation that should further strengthen tnc 


case for the short range sensor. 



Till. CONCUJSIONS 


Computer simulations nave shown that a 15 laser, 20 detector 
t lc..gulatioa sensor can be used for hazard detection on an autonomous 
r,-)vlxig vehicle. An algorithm has been developed that, regardless of the 
type of terrain, conciliates terrain slope estimates allowing the vehicle 
to locate and avoid obstacles. Because of ambiguity inherent in the 
system maximum and minimum slope estimates are computed to account for all 
terrain possibilities. The price to be paid Is that If the range of slopes 
is large, a conservatively biased vehicle declares some safe paths as 
hazardous. 

It is possible to improve perception by increasing laser density. 
While this does not Improve accuracy, the extra laser pulses increase the 
amount of data. Making detector fields smaller increases data accuracy 
without adding to the total number of data points. Computer simulations 
have shown that the cosd>ined effect of decreased laser spacing and reduced 
detector fields is to reduce the ambiguity in the system and increase the 
nuodier of safe paths available. 

It is evident from simulations that a 40** overall field of view 
is insufficient to detect all safe terrains. Theoretical considerations 
suggest a 60" field would substantially Improve the terrain interpretations. 
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APPENDIX A — CODE USTINGS 


Subroutine DIAQIL - This subroutine diagonalizes 
the laser /sensor rettums. 

Subroutine MODEL 2 - This subroutine processes 
the laser/sensor returns in accordance with the 
terrain modeling rules 
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REAL ASNUTH(50) ,POS(50,51,2) ,LASA6L(50) ,SE8GLE( ) 

HEAL BEHBNG(50) ,LAaGLB(50) 

DO 100 J=1,MU!1AZ 
DO 100 I=1,MUai.AS 
DIAG (J,I) =DATA (J,I) -I 
IP(DATA(J,I) .SQ.O) DIAG(J,I) =1000 

FORMAT r l*!lOX , • DIAGONALIZED RETORN * ) 

«aiTE(6,300) (J,J*1,N0MA2) 

FORMAT ( * 0* , * AZIMUTH* ,31,50 (IX, 12, IX) ) 

WRITE (6,400) 

FORM AT (*0*, 'LASER*) 
no 500 I=1.NUMLAS 


K=N0MLAS-I«^1 miMa-rt 

WRITE (6,600) K, (DIAG(J,K) ,J=1,N0MAZ) 

FORHATC *,3X,I2,5X,50(I3,1X) ) 

RSTOBN 

END 


ORIGINAL PAGE IS 
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SOBQOUriNE nOOEL2 

COanON/CHOOSE/NaHOD, NMSS(I,NBPSA,NHT8M,INTVDB, IMTSSM, 

6 INTaOD,INTPSA, IMTTRM.IMTGYR 

COaBOM/TIBUP/THBTNU, ALPHA, SIPIN,SLPCBS,SLPCHS,T ALLOW 
COnROii/DYMPlC/CHNnAX,UPnAX,TSHL£N,VEHUID,CRSnAX, VELHAX, 

6 DT,TUaMl,STHHAX 

CORnON/SEMSR/BSHRNG, ASnUTH, LAMGLE, RTN. KOUNT, ISCAN 
connoN/sLOPE/sLPnAx, sLPam, is topi , istcp2 

COnMON/DETECT/SE»TIH,SCMTI«,r*IRSTP,SBNSTP,SEMHI,SSNLin, 

& SENLEN,SENUID,NURBZR,IJK 

COHaON/SEMX/HITLAS,HITSSM,MOnLAS,NO«SEN,NOKAZ,INTDAT,MRDTPB, 

6 LASAGL,SENGLE,SCO!l,DATA,CIAG,POS 

REAL UANGB(50) ,SLPNA X (S 0 ,50 , 3) , SLPRIN (50,50 , 3) ,AZn0TH(50) , 

6 ASnUTH(SO) ,POS(50,51,2) ,LASAGL(SC) ,SENGLE(50) 

REAL BEnBNG(50) ,LAM6LB(50) 

INTEGER HAZARD (50) , DELTA, JOHP (50,2) , SEN1 ,SEN2,SEN3, SEN4 
INTEGER RTN (50) ,DIAG (50,50) 

INTEGBR*2 DATA (50,50) 

IP(IJK.GT.O) GO TO 7C 
RSAD(5,30) nxniSS,ZnAX, RNGHIN 
30 FORNAr(I2,8X,2F10.5) 

coNvar=i80./3 . 14159 
DO 50 I=l,NOnAZ 

50 AZaUTH (I) =ASaOTH(I) *CONVRT 

RETURN 

70 CALL DIAGNL 

C DO ONE LOOP PER AZINUTH 

DO 4000 J=1,NUNAZ 
1=1 

C CHECK FIRST RETORNSFOR HISSING DATA 

C HXniSS IS HAXIMOH MUHBER OF HISSES ALLOWED. IF THIS IS EXCEECED 

C STORE INFORMATION TO BE PRINTED AND GO TO NEXT AZIMUTH 

100 IF(D:AG(J,I) .N£. 1000) SO TO 300 

IF (I.EQ.nXaiSS) GO TO 200 
I=1M 
GO TO 100 
200 RANGE (J)=l. 

HAZARD (J) =2 
GO TO 4000 

C ISTRT INDICATES FIRST LASER MAKING HIT 

300 ISTRT=I 

C LOOK FOR MISSING RETURNS 

400 IF(I.EQ.NUHLAS) GO TO 800 

i=i*y 

IF (DIAG (J,I) .HE. 1000) GO TO 400 
C IMISSI “ FIRST LASER KITH HISSING RETURN 

IHISS1=I 

C MAX. NO. OF MISSES EXCEEDED? 

500 IF(I-IMISSl.GB.MXMISS) GO TO 700 

I = I*1 

C LOOK FOR NEXT HIT 

IF(I.GP.NUMLAS) GO TO 900 
IF(DIAG(J,I) .EQ. 1000) GO TO 500 
C IMISS2 - LAST LASER WITH MISSED RETORN 

IMISS2=I-1 

C COMPARE DIAGONALIZED RETURNS BEFORE AND AFTER MISSES; 

C INSERT LOWER DIAGONALIZED RETURN AND CORRESPONDING SENSOR 

C THAT WOULD HAVE SEEN LASER AT AIL MISSES 

DELTA=niNO(DIAG(J,l) , DI AG ( J , IMISS 1- 1 ) ) 

DO 600 K=IMISS1,IMISS2 



600 

C 

C 

700 


800 

C 

900 

1000 

c 

c 

1100 


1200 

1300 


1400 

C 

1500 

C 

C 

c 

c 


1600 

C 

1610 


C 

1650 

1700 

C 


DIAG (J,K) »DELTA 
DATA(J,K) =K>DSLtA 
CONTINUE 
GO TO 400 

IF TOO MANY (1ISSES, STORE RANGE OF LAST HIT. 

HAZARD INDICATES TYPE OF 03STACIE AND IS USED LATER. 

IHITainiSS1-1 

ISAUsDATA(J,IHIT) 

BANGE(J) =POS(IHIT,ISAH,2) 

HAZARD (J) =2 
GO TO 4000 

ISTOP=NOMLAS ORIGINAL PAGE IS 

GO TO 1000 OF POOR OT^xm IT 

BSHENBER LASER THAT CADE LAST HIT 
IST0P=IMISS1-1 

IF(IFIX(SLPIN/(CONVRT*20.))) 1100,1500, 1300 
IF PirCfl<-20 CHECK FOR HBG.OBSTACLES 
IF PITCH>20 CHECK FOB POS. OBSTACLES 
DO 1200 K=ISTRT,ISTOP 

IF(DIAG(J,K).GB.DIAG(J,ISTRT))GO TO 12C0 
ISAHsDATA (J,K) 

RANGE (J) =P0S(R,ISAK,2) 

HAZARD (J) =3 
GO TO 4000 
CONTINUE 
GO TO 1500 

DO 1400 K=ISTRT,ISTOP 

IF(DIAG (J,K) .LE.DIAG (J,ISTHT) ) GOTO 1400 
ISAW=DATA(J,K) 

RANGE (J) =POS(K,ISA«,2) 

HAZARD (J) =4 
GO TO 4000 
CONTINUE 

ICOONT - COUNTS NUSBE2 OF .. lAG. JUMPS 
ICO0NT=0 

COMPUTE LOCATION 8 SIZE CP ALL DIAGONAL JUMPS AND STORE 
IN JUMP 

JURP(N,1) - LASER BEFORE N-TH JUMP 
J0HP(N,2) - SIZE OF N-TU JUMP 
ISrOP1=ISTOP-l 
IF(ISTOPI.SQ.O) GOTO 1610 
DO 1600 I=ISTRT,IST0P1 
DELTA=DIAG(J,I«^1) -DIAG(J,I) 

IF (DELTA. EQ.O) GO TO 1600 
ICOONr=ICOOMT«-l 
JU«P(ICOUNT, 1) =I 
JOMP(ICOUNT,2) =DELTA 
CONTINUE 

CHECK PO NO DIAG. JUMPS 
IP (ICOUNT.NE.O) GOTO 1650 
HAZABD(J) =1 
GO TO 4000 

JCOUNT COUNTS MO. OP SLOPES CALCULATED 6 CHECK FOR LAST JUMP 
K=1 

JCOUNT=0 

IF(K.GT.ICOUNT) GO TO 2200 
INCRsO 

M INDICATES SIGN 03 JUMP, IF JUMP<0 ,«=-! 

N=1 

LAS1=JUMP(K,1) 



SSN1»1FIX(DATA(J,LAS1) ♦.5-M/2.) 

Z1»P0S(LAS1,SSN1, 1) 

IF (M*JUMP(K,2) .GT, 1} GO TO 1900 
1800 IMCR=INCa*^1 

C LOOK FOR DIAG. JUMP=2,1F JUMP CHANGES C1RECTI0N,ST0P 

IF(K*INC8.GT.ICOOJIT) GO TO 2200 
IF(N*JUnP(K»INCR,2).LT. 0) GO TO 2000 
1900 LAS2»JUMP(K+INCa,1) ♦! 

SEN2-IFIX (DATA (J, LAS 2) ♦. 5*M/2.) 

Z2=POS(LAS2,SEN2, 1) 

DBL2=Z2-Z1 

IF(ABS(DELZ) .GE.ZnAX) 30 TO 2100 
GO TO 1800 
2000 K=K*IMCa 

GO TO 1700 

C COMPOTE MAXIMUM SLOPE 

2100 IF(LAS2-LAS1.LE.2) GC TO 2150 

LAS3=LASU1 
LAS4=LAS2-1 

SEN3=IFIX (DATA (J, LAS3) ♦. 5-M/2.) 
SEN4=IFIX(DATA(J,LAS4J ♦.5»M/2.) 

Z3=POS (LAS3,SEfl3, 1) 

Z4=POS(LAS4,SEN4, 1) 

R3=POS(LAS3,SEM3,2) 

R4=POS (LAS4,SEN4.2) 

DELZ=Z4-Z3 
GO TO 2170 

2150 C3=POS(LAS1,SEN1,2) 

R4=POS (LAS2,SEN2,2) 

2170 DBLR=R4-33 

JCOUNr=JCOUMT*1 

SLPMAX(J,JCOUNT, 1) =ATAM2 (DELZ,DELR) 
SLPMAX(J,JCOONT,2) =R3 
SLPMAX(J,JCOOMT,3) =R4 
K=K«-1 

GO TO 1700 

C STORE NUMBER OP SLOPES CALCULATED 

2200 ISTOP1=JCOUNT 

IF (ISTOP1.ME.O) GO TO 2250 
HAZARD (J) =3 
GO TO 4000 
2250 K=1 

JC0UNr=0 

2300 IF (K.GT.ICOUNT) GO TO 28C0 
INCR»0 
M=1 

IF (JUMP (K, 2) .LT.O) N=-1 
LAS1=J'JMP (K, 1) 

SENl = IFIX(DArA(J, LAS 1) ♦.5*N/2.) 

Z1=P0S(LAS1,SEN1,1) 

IP (N*J0HP(K,2) .GT. 1) GO TO 2500 
2400 INCR=INCR^1 

IF(K*INCR.GT.l' ONT) GO TO 2800 
IF(N*JUMP(K + INCa,2) .LT.O)GO TO 2600 
2500 LAS2=JUflP(KHMCR, 1) ♦ 1 

SEK2=IFIX (DATA ( J, LAS2) *■ . 5-0/2 .) 

Z2=POS(LAS2,SEN2, 1) 

DSLZ=Z2-Z1 

IF (ABS(DEL7.) .GT.ZMAX)30 TO 2700 
GO TO 2400 



o o 


2600 K»K*IMCR 

GO TO 2300 

2700 R13P0S(LAS1,SEN 1,2) 
B2«POS(LAS2,SeM2,2) 

DELR-B2-R1 

JCOONT=JCOUNr*1 

SLe«IN(J,JCO0Nr, 1) =MAN2 (DELZ,DELR) 
SLPttIJI(J,JCOOJIT,2) =S1 
SLP«IN(J,JCOOST,3) 


2800 

C ADJUST SLOPES FOR VEHICLE ATTITUDE 

CALL PITCH (J) 

SEARCH FOR OBSTACLES 

FIRST CHECK SLPHAX FOR CLOSEST SLOPE>CRITICAL VALUE 
DO 2900 I=1,ISTOP1 

IP (SLPHAX (J, 1,1) . LI. UPHAX.AMD.SIPHAX (J,I, 1) . GT. DKMHAX) GO TO 29 00 
IF(SLPHAX(J,I,2) .Gr.RNGHIM) GO TO 3000 
RANGE (J) »SLPMAX (J, I, 2) 

HAZARD (J) =5 
GO TO3200 
2900 CONTINUE 

HAZARD (J) =8 
GO TO 3200 

3000 IF(ISTOP2.EQ.O) GO TO 3100 
DO 3100 I=1,ISTOP2 

IF(SLPHIN(J,I, 1) . LI. OPHAX.AND.StPHIN (J ,1, 1) .GI.DHNHAX) GO TO 3100 
RANGE (J) =SLPHIN (J, I, 2) 

HAZARD (J) =6 
GO TO 3200 
3100 CONTINUE 

HAZARD (J) -7 

3200 IF (INTHOD.NE. 1) GO TO 4000 
HRITE(6,3300) A2HUTH (J) 

3300 FORHATC-* ,• AZIMUTH ANGLE DEGREES') 

IP(*STOP1.LT. 1) GO TO 36 2 0 
DO 3320 I=1,ISTOP1 

3320 SLPHAX(J,I.1) =SLPf!A X ( J , I , 1) *CONVRT 

WRITE (6, 3400) (SLPMAX (J, I , 1) , 1=1, IS TOP 1) 

3400 FORMAT('0', 'HAX S LOP E (D EG) • , 50 ( 2X , F4 . 0} ) 

HRITS(6,3500) (5LPM A X ( J , I , 2) ,I = 1,ISTCP1) 

3500 FOHMArC '.'MIN RANGE(M) * . 2X , 50 (2 X , Eb , 1 ) ) 

HRITE(b,3600) (SLPM \X (J, I , 3) ,I = 1,IST0P1) 

3600 FOKMATC *,'«AX RANGE(M) ' , 2X , 50 ( 2 X , F5 . 1 ) ) 

3620 IF(ISTOP2. IT. 1) GO TO 4000 
DO 3640 I=l,ISrOP2 

3640 SLPMIN(J,r,1)=SLPfirN(J,I, ))*CONVRT 

WRITB(6, 3700) (SLPniM (J, I , 1) ,I = 1,ISTOP2) 

3700 FOitMAT(*0*,*«IN SLOPE(DEG) • , 50 (2X, F4. 0) ) 

WRITE (6, 3800) (SLPMxN (J, I ,2) ,I = 1,IST0P2) 

3800 FOXMATC •,*HIN RANGE(M) * , 2X , 50 ( 2X , F5 . 1) ) 

WRITE (6, 3900) (SLPM IN (J, 1 , 3* ,r=1,lSTCP2) 

3900 FOHMATC •,'MAX RANGE(M) X , 50 ( 2X , F5 . 1) ) 

4 000 CONTINUE 

C OUTPUT DATA ON AZIMUTHS 

WR1TE(6,4 100) 

4 100 FORMA re 1' , • AZr MUIh* ,46 X , • TER RA IN CHARACTERIZATION' ,4 3X, »STN*) 

DO 2001.0 J=1,NUMA2 
I = HA2ARD (J) 


K=K* 1 

GO TO 2300 
ISTOP2=JCOONT 



GO TO(5000,6000,7000,80CC.9000, 10000, 1 ICOO, 12000) , I 

5000 

HaiTE(6,5S00) J 

5500 POaflAT<*0»,3X,I2,5X,»SCAN IHDICATES LEVEL GROOHD, TEBBAIH * 

1 ,»IS PASSABLE. •,61X,»1») 

GO TO 20000 
6000 BTV (J) «0 

OBITE (6,6500) J,nXBlSS,BAN6S (J) 

6500 FOBBATf'O*, 3X,I2,5X,I1, » HISSING BBTORNS DETECTED BEGINNING*, 

1 ‘AT A BANGS OP *,P3. 1,* HBTBBS. TEBBAIN IS NOT PASSABLE.*, 

2 23X,*0*) 

GO TO 20000 

7000 BTN (J) *0 

HBITB (6,7500) J,BAN6E (J) 

7500 FO«BAr(*0*, 3X, 12, 5X, *NBGATIVB OBSTACLE DETECTED AT *,F3.1, 

1 * BBTEH BAMGE WITH VEHICLE PITCH BELOW A SAFE LEVEL. NOT*, 

2 * PASSABLE. *,10X,*0*) 

GO TO 20000 

8000 RTN(J)sO 

WRITE (6,8500) J,BAN6E (J) 

8500 FOBBAT(*0*,3X,I2,5X, *POSITIVB OBSTACLE DETECTED AT *,F3.1, 

1 *flETBR RANGE WITH VEHICLE PITCH ABOVE A SAFE LEVEL. NOT*, 

2 * PASSABLE.*, 10X,*0*) 

GO TO 20000 

9000 RTN (J) »0 

WBITB (6, 9500) J, BANGS (J) 

9500 FORHAT(*0*, 3X,I2,5X, *OBSTACLB DETECTED AT *,F3.1,* HETER RANGE 

1 ,* WITH POSSIDLX HA2ARDOOS SLOPE. TERRAIN WILL BE AVOIDED. 

2 16X,*0*) 

GO TO 20000 

10000 RTN (J) =0 

BRITS (6, 10500) J,RANGE(J) 

10500 FORHAT(*0*,3X,I2,5X,*OBSTACLE DETECTED AT *,F3.1,* METEB RANGE 

1 'WITH DEFINITBLI HAZARDOUS SLOPE. TERRAIN IS NOT PASSABLE. 

2 14X,*0*) 

GO TO 20C00 

11000 RTN(J)=1 

WHITE (6,1 1500) J 

11500 POBHAT(*0*,3X,I2,5X,*POSSIBLS OBSTACLE DETECTED BOT NOT CLOSE 
1 'ENOUGH TO NECESSITATE A VOIDANCE. ' , 38X, ' 1 ' ) 

GO TO 20000 
12000 HTN(J)=1 

WRITE (6, 12500) J 

12500 FO2HAT(*0*,3X, 12, 5X, 'OBSTACLES DETECTED ARE NOT HAZARDOUS.' 

1 ,* TERRAIN IS PASSABLE. *,52X,*1*) 

20000 CONTINUE 
BETORN 
END 

SOEROUTINE PITCH (J) 

COMHON/SENSB/BEHRNG, ASH 0TH,L ANGIE, BTN, KOUNT,ISCAN 
COHHON/TIEUP/THETNU,ALPH A, SLPIN,SLPCRS,SLPCHS, TALLOW 
COHHON/SLOPE/SLPHAX, SLPHIN, ISTOP1 , ISTOP2 
REAL SLPHAX(50,50,3) , SLPHIN (50,50,3) ,ASHUTH (50) 

BEAL BFHQNG (50) ,LANGLE(50) 

INTEGER BTN (50) 

C THIS SUBROUTINE CORRECTS CALCULATED OBSTACLE SLOPES TO ACCOUNT 

C FOR VEHICLE ATTITUDE. 

C 

DBLTA-ASnUTH(J) ♦ALPHA 

THETAaATAN (TAN (SLPIN) *COS (DELTA) -TAN (3LPCRS) *SIN (DELTA) ) 



DO 100 I»l,ISTOP1 
SLPnAX(J»I,1)>SLPnAX(J,I, 1) ♦THETA 
100 CONTINUE 

DO 200 I»1,ISTOP2 
SLPMIN (J,I,1)=SLPtlIM (J,I, 1) ♦THETA 
200 CONTINUE 
RETURN 
END 
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